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therefore, 
t 
KE 
6(t) = ah w(t) dt 
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A similar derivation holds for the other axis; i.e., a transfer 
function relating 6 and wp can be interchanged so that 
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The "ideal" model (Sectzon LII.A), behaves like a perfect gyroscope. 
The "dynamic" gyroscope is far more complicated with realistic inertia 
and damping terms being considered. A 2-DOF dynamic gyro is represented 
by two second order differential equations as given in Section III.B. 


lil. MATHEMATICAL GYRO MODELS 


The mathematical formulation of the two gyroscope models is 
given in the following paragraphs. 


A. Ideal 2~DOF Gimballed Gyroscope 


Figure 1 describes the orientation of the seeker gyro 
coordinate system (x,, vo 2.) by using the seeker Euler angles 6 and 


then » with respect to the body coordinate system (X,, Ype Zp)- The 


gyro coordinate system is chosen so that the origin is at the center 
of mass of the gyro and the x-axis is the axis of symmetry of the 
gyro. Also let w' be the absolute angular velocity or rate of the 
seeker gyro. Then the general expression for components of angular 
momentum H of the gyro is 


H = wo 
x XX X 
H = w' 
yy y 
= 1 
H Le Ys ; (1) 


Let w be the absolute angular velocity of the Xoo Yoo 2, system and s 


be the angular velocity or spin rate of the gyro as measured relative 
to the Xe» Yep system. Then the angular velocity terms (w)> a3 w)) 


are 
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I. INTRODUCTION 


A gimballed two-degree-of-freedom (DOF) attitude gyro whose 
spin axis is torqued to a point along the line-of-sight (LOS) is a 
primary guidance device used in today's missile technology. LOS rate 
for proportional navigation guidance (PNG) is derived from this type 
of gyro. The guidance law for this scheme is PNG. The missile used 
here is tail controlled with proportional vane deflection and roll 
rate controlled. When the missile is near enough to the target to be 
seen by the guidance device (seeker) which is mounted on the gyroscope, 
an LOS error (the difference as measured in both yaw and pitch plane 
of where the seeker is presently pointing and where it should be 
pointing) is computed. This LOS error torques the gyroscope and 
eventually drives the missile body vanes which turn the body into 
line with the pointing seeker. Missile targeting accuracy is described 
for two types of 2-DOF gimballed gyros (idealized and dynamic) models 
when implemented in a 6-DOF digital missile simulation with no changes 
in airframe, aero, autopilot, and guidance law. 


Il. PROBLEM DEFINITION 


For many studies using digital simulation, it is desirable 
to model a gyro which has no second order (inertia) and damping terms 
in the mathematical formulation. This model is one represented by a 
perfect integrator, 1/s, in the Laplace notation. The following 
paragraphs display the rationale in developing such a model. 


The differential equation relating output axis motion to input 
torque or rate is 


Jé + BB + KO = HY ; 


Laplace transformation with zero initial conditions is applied 


0(s) Hs 


¥(s) jg? + Bs + K 


and it is assumed that J »>B and J >K 
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therefore, 
t 


6(t) = ae w(t) dt ‘ 
0 


A similar derivation holds for the other axis; i.e., a transfer 
function relating 6 and p can be interchanged so that 
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The "ideal" model (Sectxon III.A), behaves like a perfect gyroscope. 
The "dynamic" gyroscope is far more complicated with realistic inertia 
and damping terms being considered. A 2-DOF dynamic gyro is represented 
by two second order differential equations as given in Section III.B. 


li, MATHEMATICAL GYRO MODELS 


The mathematical formulation of the two gyroscope models is 
given in the following paragraphs. 


A. Ideal 2-DOF Gimballed Gyroscope 
Figure 1 describes the orientation of the seeker gyro 
coordinate system (x,, Yas 25) by using the seeker Euler angles 6 and 
then » with respect to the body coordinate system (X,, Ype Zn). The 


gyro coordinate system is chosen so that the origin is at the center 
of mass of the gyro and the x,axis is the axis of symmetry of the 


gyro. Also let w' be the absolute angular velocity or rate of the 
seeker gyro. Then the general expression for components of angular 


momentum H of the gyro is 


H =I w' 
x XX XK 
H =T1 ' 
y yy y 
= 1 
H= 1, 0 ; (1) 


Let w be the absolute angular velocity of the Xe» Vor 25 system and s 


be the angular velocity or spin rate of the gyro as measured relative 
to the Xo Yap system. ‘Then the angular velocity terms (wy ie wo) 


are 
4 


Figure 1. Seeker gyro coordinate system. 
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H =I wo : (3) 


The ;eneral vector equation of motion is M = H. Recalling that the 
rate .{ change of H is 


R= @® tek (4) 


where (H) is the ra-e of change ot the absolute angular momentum as 
measured in the seeker gyro basis, i.e., 

: = ‘ 45) : : ‘ 

(H) Lx (w,. +osji + Gy ws + (1... wk . (5) 


From Figure 1, 


e . 


w= Osinvitdcoshi* be  . (6) 


Because of the gyro symmetry and actua. specification values, a 
special case is treated here, i.e., 


l=Il =I 1 : (7) 
In Figure 1, s is a constant spin rate and s ww, and wo3 therefore, 
He Isi= h . (8) 


For an 1deal gyro, the rotor gimballed terms (uy and w,) are small when 
compared to the wyS and w,8 terms; also, no Wy term is possible due to 
the physical system constraints. Therefore, (H) can be neglected in 


comparison with w x H. 


Evaluating » x H using the determinant form of the cross sxoduct 
gives 


i i k 

wx hs 8 sin v 6 cos yp ow ‘ (9) 
I 0 0 
s 

Then 
M =0 
M =sIsq 
y sy 
M. = -Is 6 cos (10) 


where Is is angular momentum and is considered a constant gain value 


in the model. 


B. Dynamic (Realistic) 2-DOF Gimballed Gyroscope Model 


Figure 2 shows the system in a configuration (with 
respect to body fixed reference Xp» Yy> Z5) and orientation of the 


gyro system by using the seeker Euler angles ) and then 8. Thesystem has 
2-DOF (the speed n of the rotor with respect to gimbal G prescribed 

as constant). Angle @ defines the angular position of the inner 

gimbal G with respect to the outer gimbal 0. The angle \ defines 

the angular position of the outer gimbal with respect to the vehicle I. 
Using the general vector equation of motion (M) = (H) and rewriting 

in matrix expressions gives 


(My) = (Bs) (11) 
{Hyg} = (Hy) + (Hy) + {HQ} (12) 
but 
(Hy} = [Ip] {w9_7} (13) 
(Hg) = [Tg] (w, 4) (14) 
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Figure 2. Dynamic seeker gyro coordinate system. 


and 


{H,} = [T,] fo, b= (EQ) {wp gt + tug_7} 


I 


but {we = {$}. Therefore, 


@) 
Hy = [Ip] (6) + [Ip] ug_7} 


but (I, ] {$} = {h}. Then 


{H,} = Ch} + [I,] {w,_5} 


where 


{M,} 


{H,,.} = angular momentum of total system 
TS : 
I vehicle frame 


(15) 


(26) 


(17) 


moment or torque (column matrix) about outer gimbal 


(column matrix) in 


Ve {iy} angular momentum (column matrix) of outer gimbal 


i {lig} = angular momentum (column matrix) of inner gimbal 
: {h} = angular momentuw (coun. matrix) of rotor 

{Hi} = total angular momentum (column matrix) of rotor 
] = inertia tensor of cuter gimbal 


[ig] = inertia tensor of truer gimbal 


[T,] = inertia tensor of ‘ocor 

{wo_7} = angular velocity (c»Llumi matrix) of outer wrt vehicle 
{we_y} = angular velocity (column matrix) of inner wrt vehicle 
{wp} = angular velocity (co!unn matrix) of rotor wrt vehicle . 


q : ¢) 
{g} = (9 
b 


Rearranging Equation (12) and taking derivatives of Equations (11) 
and (12) gives 


. d 
(Ng) = (ligg) + Lug] Ugg = ge [ tn} + (tg) fug_y) 
# [1,) done) (1A) foe. oP fe] 
G? *%G-1 0 on], G-I 


[ om - (I, ] {wo} + (1.1 {we +} + [Ip] (a) 9 (18) 


where 


Therefore, 


} 
I 


{ H. é 


(dg + ig) (gg) + Cig) gg) + Cig), leg) 


+ 


PP) tes ch Se Ty eee oe) 
G G-I G ie) 0 0-1 ¢] O-I 0 


+ 


[wz] fa} + [ug 7] (Tg) + [1g]) fog, 
+ [woz] [T)} {wo_7} oy (19) 
Collecting terms gives 


{Mj} = (Hyg) = th}, + ({1,] + [Ig] ) fgg) + [Ip] (a) 


ioc th ie PS Te i) (20) 
Consider that for a constant speed motor 
fh), = 0, (21) 


and neglecting the second order terms, 
log z) (Ug) + (gl) f4g_7) 
then, 


{My} = ({t_] + [1,]) (agg) + Et (gy) + [wo_7] {hb . (22) 


Thus, Equation (22) is the simplified moment equation, but the moment 
equation for a complete gyro is Equation (20). 


, \ry Coordinating the equation to get scalar components in the inner 
Ba gimbal frame G, then 


{fh} = [1,] fw. 6) , (23) 


Therefore, 


me ne 


° ce de = ° 
{ihe = ge (it, (n¢)). an {upp} + [EQ] tBnee aiet) 


Then 


ies 

>: 

ved 
i 


este) « (25) 


(h}, would be zero if spin rotor rotated at a constant speed as with 


a hysterisis motor. In some application, "h-modulation" may be 
desirable, so retain the term th}, j.e., th}, #0 


Using the matrix properties of the inertia tensor to find an 
orientation of a given rigid body so that all products of inertia are 
zero simultaneously, i.e., the inertia matrix is diagonal. Substituting 
A, B, C for Le? 1 heat Loe? respectively, then Equation (25) becomes 


yy 
AR 0 0 0 0 
‘ 7, Yr 5 = = 
{h}, = [Z], {o}, i Be 0 ® (26) 
0 0 CR co) Cpe 
AR + Ac 0 0 
( (29) + [Lg] )- 0 BR + Bo 0 : (27) 
G G 
0 0 Cp + Co 
Knowing 
{w. .} = fw, .} +7. {w, ~} ; (28) 
‘Bry G-I G G-0O G OG 0-1 0 
then 
0 4 
. fw} =[6]; {w,-} =|0 (29) 
: G-0 G O-T 9 
: ? : 
‘ A and 
{ * 
ral’. & 
| 3 11 


“aia AIREY ay, 


Neapite ea le 
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ped - p so 6 
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ys6 + rT c8 8 


(H.} = [I] {ow 
0 (@) I O-I 0 


Therefore, 


-s@0 


(30) 


(31) 


(32) 


(33) 


the derivative of H, in IL frame coordinatized in the G frame 


Il 
Lac) 
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(34) 


(35) 
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where 


and 3 
(c' - B') OWséd 
+2 
[woz] [1p] + [Ig] fog} = | A" - Cc") v'cbs6 
(B' - A') bce 
where 
Uo 
A A + AG 
Te 
B= Bp + Ba 
’ = 
C CR + C 
Moxe 
{M.} =IM 
i@) G OYG 
Moze 


Collect all terms in Equations (26) through (37) to get matrix 
formulation: 


Hove 0 A' 0 O77 bce - bs06 Aybco 

Move l=| © [+] Br 0 ) +] 04 

Mood Lor $1 LO 9 cil bso + 8ce6 Abs9 
6h (c’' - B') ewWse 


+ |-nyeo) + | (at = 0") 67 cos0 
0 (B' = A') 6c 
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(36) 


(37) 


(38) 


Add all matrices as indicated and break out individual components 
as follows to get complete nonlinear equations with no restraints on 


motor: 


ul 


M (An + Ag + Ag) bcd 


OXG 


+ (-A, - Ag ~ Ba ~ By + Cp + CQ) 6ys0 + hé 


= 
f 


7 x -2 . 
ovG (Be + By) 8 + (Ap + Ag CR - C.) ycOs8 - hypcd 


Mog = Cp Ot (Ch +C, + BL +B, - A, - AQ) bpd 


+ AG, Cy oA.) psd (39) 


G 


where 


OXG wv 


M = 0 (40) 


and 


gimbal bearing friction between the outer gimbal and base 


ry 


1c 


be bearing friction between outer and inner gimbal 


For a general linear solution of Equation (39), linearize about an 
equilibrium position by letting: 


0 + 0 | 


@ 
u 


6= 6 + 6 


p + op 


7 
Mi 


p + 8p ) etc. 


Gee 
u 


Substitute into the nonlinear Equation (39); i.e., about 9 = 0 
for small 6 about equilibrium, e.g., 


c0cd0 - s0sdé 


It 
pa 


cé 


c(6 + 66) 


sé = s(0 + 66) = s0cd0 + cOsd0 = 56 ‘ (41) 


Using the first of Equation (39) and substituting the preceding gives 


Moye (linearized) = Ab + A'OS0 + hO (42) 


where 


A AR + Ag + Ay 


B= “AR = AG - Bp Ba + CR + Cc 


oxe tT Moye = AY + AdH + BCO + 50) (p + dp) Sp + ho + hdO . (43) 


M 


Subtracting Equation (42) from Equation (43) gives 


BMoxe = Ady + BOSPSO + BSOYSO + BSOSUSO + hSS . (44) 


Ali small second terms can be removed in Equation (45), therefore, 


SMoye = Ady + héd . (45) 


A similar method can be applied to the M equation in Equation (39) 


. OYG 
to give 


SM 0, = Béé - how ; (46) 


dropping the 4i terms for small angle approximation to get 


Moxc = Ap + hé 


Moye 


Bé - hy . (47) 


Substituting values from Equation (40) for Moxg and Moye 


angle approximation into Equation (47) to get 


with small 


M 


Ab + xb + hO y 


Bd + bd - hy My : (48) 


IV. SYSTEM SIMULATION 


The guidance and control system block diagram pitch/yaw 
channels for the 6-DOF digital simulation is presented in Figure 3. 
Figure 3 shows how the signal generated by the seeker is used to drive 
the vanes. Tne seeker signal is routed to the gyroscope and damping 
network before going to the guidance filter. It also goes directly 
to the guidance filter. The output from the guidance filter is then 
sent to the actuator which in turn drives the vanes. The only change 
between evaluation of the two types of gyro models would be in the 
torque gain terms and the block marked "Gyro Model" as shown in 
Figure 3. The 6-DOF computer program listings are given in Appendices 
A and C. A Continuous System Simulation Language (CSSL) program is 
given in Appendix B. The CSSL program was utilized to analyze only 
the motion of the dynamic gyro prior to implementation in the 6-DOF 
simulation. 


In this section, the CSSL program results are given for the 
dynamic gyro model. The 6-DOF digital missile trajectory results 
are given for both the idealized and the dynamic gyro models. In 
addition, comparison analyses of the two trajectory simulation 
results are made. 


A. 6-DOF Digital Simulation with Ideal 2-DOF 
Gimballed Gyro Model 


A detailed block diagram of the ideal gyro model is 
shown in Figure 4; of the dynamic gyro model in Figure 5. The gyro 
system equations of motion are presented for pitch/yaw channels as 
follows: 
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Figure 5. Gyro model in the 6-DOF simulation. 


= 6 + 
Ty 5 Cos v5 QSA 


Ty = ¥, + RSA (49) 


where QSA and RSA are transformed of missile body rates, Q, R; 
respectively, and 8,cos Y,and pare My and M9 respectively, as taken 


from Equation (9). ‘Table 1 gives the units, symbols, and names of 
the missile parameters used for all plots with respect to the time 
presented in this report. The 6~DOF digital trajectory simulation 
program and tabulated results are presented in Appendix A. Plots of 
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the missile parameters are given in Figures 6 through 55. Figures 6 
through 14 represent the results of the missile (translational and 
angular velocities) and body Euler angles. Figures 15 through 20 show 
the missile position and missile to target displacements. Figures 21 
through 35 represent the autopilot and actuator parameters during 
flight. Figures 36 through 39 show the seeker input-output values in 
flight. Gyro parameters are given in Figures 40 through 55. Results 
indicated that when an ideal gyro is utilized, the missile to target 
RSS accuracy is 0.215 ft at impact for a 4-km (13,120-ft) target in 
14.922 sec. X, Y, Z missile error components at impact are 0, -0.0183, 
and -0.2, respectively. The signs on the error components mean the 
missile hit to the left and above the target. 


B. Dynamic (Realistic) 2-DOF Gimballed Gyro 


In order to obtain a more realistic assessment of a 
2-DOF gimballed gyro performance, efforts were made to model the 
dynamics of the gyro more acvurately. The equations of this model are 


given in Section III.B. 


When consid+ring Equation (48) for the 6-DOF digital simulation, 
the signs on thc precession rates (h0, hy) will change because of dif- 
ferent coordinate systems, i.e., a positive Ty will give a negative hd 


precession rate and positive Ty will give a positive hw precession rate, 


Thus, 


Hi} 
Lae} 


Aw + ry - he 
B6 + bO + hi = T 
where 


A and B = moments of inertia 
r, b = gimbal bearing friction 
h = angular momentum 


T., T, = moments or torques 


Tke preceding typical parameter values of this gyro, which has to 
eanibsc a 10-deg/sec tracking rate and 160-Hz nutation frequency, is 
given in Table 2. 
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TABLE 1. PROGRAM VARIABLES AND DEFINITIONS 


co) 


vA 
DELXS 


DELYS 
DELZS 


THRBS 


PSRBS 


THBS 
PSBS 
PED 
YED 
PEF 
YEF 


Time of missile trajectory (sec) 


Missile velocity in body coordinate system (BCS) 
(X-comp) (ft/sec) 


Missile velocity in BCS (Y-comp) (ft/sec) 


Missile velocity in BCS (Z-comp) (ft/sec) 


Angular velocity of missile (about X-axis, roll rate) 
(rad/sec) 


Angular velocity of missile (about Y-axis, pitch rate) 
(rad/sec) 


Angular velocity of missile (about Z-axis, yaw rate) 
(rad/sec) 


Euler angle transforming earth coordinate system (ECS) 
to BCS (rad) 


Euler angle transforming ECS to BCS (rad) 
Euler angle transforming ECS to BCS (rad) 


Position of missile in ECS (X-component) (ft) 
Position of missile in ECS (Y-component) (ft) 
Position of missile in ECS (Z-component) (ft) 


Missile to target displacement in seeker coordinate 
system (SCS) (X-direction) (ft) 


Missile to target displacement in SCS (Y-direction) (ft) 
Missile to target displacement in SCS (Z-direction) (ft) 


Output of the differentiator (rate damping) of pitch 
autopilot (A/P) (rad) 


Output of the differentiator (rate damping) of yaw 
A/P (rad) 


Output of the dead band zone limiter pitch A/P (rad) 
Output of the dead band zone limiter pitch A/P (rad) 
Input to guidance filter (pitch plane) (rad/sec) 
Input to guidance filter (yaw plane) (rad/sec) 
Output of guidance filter (pitch plane) (rad/sec) 
Output of guidance Filter (yaw plane) (rad/sec) 
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PEG 
YEG 
PHIG 
REG 
DELVP 
DELL 
DEL3 


PITERR 
PITERO 
YAWERR 
YAVWERO 


DTHTAS 


THTAS 


DPSIS 


PSIS 


OMEGZ 
OMEGY 
QSA 


RSA 


DTHASD 
THASD 
DPS1SD 


PS1SD 


TABLE 1. (CONCLUDED) 


Output of pitch A/P (rad) 

Output of yaw A/P (rad) 

Input to shaping filter of roll A/P 

Output of roll A/P (rad) 

Equivalent vane deflection (pitch plane) (rad) 
Deflection of Vane 1 (rad) 

Deflection of Vane 3 (rad) 


Seeker input - LOS error in pitch plane (rad) 
Seeker output - LOS error in pitch plane (rad) 
Seeker input ~ LOS error in yaw plane (rad) 


Seeker output - LOS error (rad) 


Time derivative of THTAS (rad/sec) 


THETA angle of gyro seeker (rad) - pitch angle 
between the body and seeker axis 


Time derivative of PSIS (rad/sec) 
PSI angle of gyro seeker (rad) - yaw angle between 


the body and seeker axis 


Gyro torque input from seeker (rad/sec) 
Gyro torque input from seeker (rad/sec) 


Transformation of P, Q, R into the SCS for gyro 
(pitch plane) 


Transformation of P, Q, R into the SCS for gyro 
(yaw plane) 

Time derivative of THASD [(rad/sec)/sec] 

State variable - time derivative of THATS (rad/sec) 
Time derivative of PSISD [(rad/sec)/sec] 


State variable time derivation of PSIS (rad/sec) 
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1. CSSL Program 


The gyro model with parameters (Table 2) was 
incorporated into the CSSL simulation. The results, presented in 
Figure 56 with use of the typical CSSL program listing given in 
Appendix B, indicated the gyro behaved as expected with step inputs, 
that is, it exhibited the 10-deg/sec tracking rate and the 160-Hz 
nutation frequency. At this point, the gyro model was incorporated 
into the 6-DOF digital missile trajectory simulation. Section IV.B.2 
gives the results of implementing the dynamic gyro model in the 
6-DOF simulation. 


2. 6-DOF Digital Simulation with Dynamic 
2-DOF Gimballed Gyro Model 


The idealized gyro model was replaced by the dynamic 
gyro model and successfully implemented in the 6-DOF simulation. A 
detailed block diagram of the dynamic gyro model is described in 
Figure 5 and the second order differential equations of motions for 
the gyro are shown for the pitch/yaw channels. 


ii} 
4 


AD, + rv, - he. 


i) 
ac) 


Bb + be + hy 
s s s 


The 6-DOF digital trajectory simulation program and tabulated results 
are shown in Appendix B. Again plots of the missile parameters are 
presented in Figures 57 through 120. Figures 57 through 65 give the 
results of the missile translational and angular velocities and body 
Euler angles in flight. Plots of the missile position and target 
displacements are shown in Figures 66 through 73. Figures 74 through 
88 give autopilots and actuator parameters plots. Plots of seeker 
input-output values are shown in Figures 89 through 92. Gyro 
parameters are given in Figures 93 through 120. The missile to 
target RSS accuracy is 1.68 ft at impact for the 4-km target in 
14.936 sec. X, Y, Z missile error components at impact are 2.00, 
-0.154, and 0.1, respectively. The signs on the error components 
mean the missile hit in front, to the left, and above the target. 
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Cc. Comparative Analyses 


When considering the dynamic gyro model without the 
damping terms (rp, bé), the gyro equations of motion become 


BO + hy = 
~hd + Ab = T : (50) 


p 


The Laplace transform is used for the equation of motion: 


T,(s) 
ee + 4 s (o) o + s0(0° )+ écot ) aoe Yo" ) 
“| T (s) , 
- bse s*|| ¥ 1 2 ao") + sy(o") + (0%) . (52) 


Therefore, the characteristic equation is given from the left-hand 
side of the preceding equation by 


2 
2/.2 ,h 
s (s + *) = 0 (52) 


the roots of which are s = 0, 0 and s = tijh VAB. The zero roots give 
"constant" motion. The imaginary roots give an oscillation at frequency 
= h/YAB. ‘To obtain a magnitude of w, the gimbals are massless and B, 
A are diametral moments of inertia of the rotor. ‘They are equal to 
one-half its polar moment of inertia, B=A=TI - Since h = In 
x/2 x 
where n = rotor speed, then 


= 2n ‘ (53) 


Therefore, the oscillation frequency is twice the spin speed. However, 
because real gimbals are not massless, the real gyro has an oscillation 
frequency somewhat less than 2n as is true in the dynamic gyro model. 
From the preceding characteristic equation, the oscillatory motion is 
undamped. Therefore, the rate-dependent terms (h@, hp) act only as 

the gyroscopic coupling terms and do not produce energy dissipation 

for damping. Therefore, all damping occurs from the ry and bé terms. 
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Figures 93 through LOO and Figures 105 through 112 demonstrate the 
oscillatory frequency with damping and precession of the dynamic gyro. 
; Figures 96 and 108 exhibit the 160-Hz nutation frequency of the gyro 
and 10-deg/sec tracking rate. ‘The ideal gyro model reflects only the 
i/s characteristics as seen in Figures 40 through 49. 


The velocity and rotational components (V, W, Q, and R) of a 
missile in flight with the dynamic gyro model (given in Figures 58, 
59, 61, and 62) show a definite increase and oscillatory effect with 
damping in the velocity components as compared to the ideal gyro. 

The body Euler angles 9 and p reflect this motion. The autopilot 
parameters also show the influence of the dynamic gyro response. 
Actuator output to the vanes (DELVP, DELL, and DEL3) also reflect the 
differences between the ideal and dynamic gyro models. 


Impact accuracy of the missile to target when utilizing an ideal 


gyro model or a dynamic gyro model in a 6-DOF digital simulation is 
shown in Table 3. 


TABLE 3. IMPACT ACCURACY 


RSS 
Miss 
Time X Y Error Distance 


Ideal Gyro 14.922 13120 -0.01832 


Dynamic Gyro 14.936 13118 -0.15455 


: NOTES: X indicates range of target at 13,120 (4 km). 
Y indicates crossrange error (minus left of target). 
Z indicates vertical error (launched at -4000 ft above 
sea level. 


As can be seen in Table 3, the dynamic model will produce a better 
iB assessment of the missile accuracy at impact because a more realistic 
gyro model is used in the simulation. 


The primary 6-DOF programming difference between the ideal and 
dynamic gyro models as seen in Appendices A and C, respectively, is in 
“ the subroutine EDSKRGYRO. This subroutine reflects the change in gyro 
‘ models. 


onientn nnn ne 


V. CONCLUSION 


This report has demonstrated that a dynamic gyro model, when 
utilized in a 6-DOF digital missile trajectory simulation, will give 
a more realistic assessment of a seeker gyro than an ideal gyro model. 
Most 6-DOF digital simulations in the past have used primarily the 
2-DOF ideal gyro model. No efforts were made to change the autopilot 
or seeker characteristic in this study to accommodate the dynamic 
model. Reasonable results were obtained without change. However, 
considerations should be given to the use of the 2-DOF dynamic model 
based on results of this report. More accurate autopilot design and 
seeker interface design would probably result in the use of the dynamic 
gyro model for digital simulations. 
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Appendix A. 


6-DOF DIGITAL MISSILE TRAJECTORY SIMULATION 
? WITH AN IDEAL GYROSCOPE MODEL. 
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608 29 COKTIAUE 
60S Pian aa hs 
606 c PRACESS TIC PARKS @N CHANNELE 6 aNO A 
607 c 
6c8 TICL ee 
6c TP CTIMELTOOBLECTIC}IGO T® 1777 
610 ¢ 
Se SET EVENT CEE ee Pe ae 
612 c 
643 IP (KAGE SEC e2)TICL eTICL ool 
61s IFCNLLL cECe 2) TICLeTICL oe8 
618 TleoviceTIcr 
616 TICLeTICL 4908 
ey weet LCA OS a ae GR ee Le ees ee : ris ts 
618 ¢ SET ACCUISITIGN SIGN 
419 ¢ 
620 TF (VACGeECe2) TICLeeTICL 
623 1777 CONTIAVE 
622 PHCOATANZ(STN(PHI) ,COB( PHT} 
CLG ere ee ne re ae ee a aie aa = 
688 ¢ PROCESS MOAC GLFFER 
625 Cc 
686 MCaC CLSTICL/SFO PeOaC (OG) aVICL SFB 
677 MEACICZ) BC AL 7080000) /SFI SMIAC(LUDPeRDTOAMEQV/SFS 
628 PCAC (CI) STOTACC/SFO EMOACL 11 peRACEPEFL/SFIO 
SI PRCT CRT ERED STHTAS TSE SORE TURD OTHERS SPI 
430 WCAC(CS) @R200PEIS/SFa ahOaC(39) eQacePEG/SF 2 
631 “OaC (06) OR2DCCELROL “SFS sPOAC( 18 eRaeTHRES/SF 12 
422 MC aC (07) eR2CCOEL VY GFA aeCaC( LR yeRADCORLAMY/SF 18 
633 wCAC(C8} ORZOCRDEL VP /SF7 MOAC (16 yeQPCePHTA/SFIS 
638 Cc 
i >}. eeenenees Cehemmeen Of 00 © hel *2 1 mk do) aaaeiaos as eee es 
638 Cc 
637 OO 1892 Ivi,16 
628 TF (ABS(MOAC(T) ) 06% 0009939 IMNACL I DOSIGN( 09999, 4CAC(T)) 
633 ““{S92 “CONTIAVE 
640 c 
SE ETRE RE == mec 
642 c 
6ay x CALL WOACSIO4 16.”DaC; 
baa x TERReISVOTAPE (ENGL (TIME) s2200TXED} 
6a5 PRATAEXTOPRINTHOL Fes 
646 TFCTIME SL VePRNTNEXTeANDoIPRINTECe1 IGE TH 72 
EI TPT IE TOE VPRETREXT TOR INEM SOREN T eK Kel T Fa years Pe, tea a ed 
628 TPRIATOL 
6a9 70 THPLSBINIPRT) 
680 ThP2eCOB( PHT) 
631 PROSATAM2 (THP2 ys THRE) 
682 Cece ect a tect eee Pec cr ewe wee weeteteewotees CaF Canepa et eaasersssiaetesenagereanes( 
SS SS eae SSS — Soe Oe SE 
654 Cc LIKE PRIWhYTERA t/a Cc 
683 ¢ C 
636 Cae ence te cnet a tet ua cenewac ewe e le cer eens eter een ge ene tense eneasgetaunwcaneeesee(” 
687 IFCGATE(003))GO TH 1661 
654 PRIKT 900C7 
B89 R80 800 ris CHEEG by OHNE Ky CHE Er Ot A ty--- 
66C {ahBF 74k aGr a SHRTOL, OH aRTPL, 
661 14*8G 78h 86 yehRA yan aBas 
662 LeheRs 2a BRE gsHKP yay KP, 
663 tahkBRS 70H ORS abkeQ 44h 2*O, 
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664 {ORATY 24k 2BT4 s4RATO ,&b 2272 ’ 
66F {4FCPY ,4H a CPT 24HSTY , 4H 2STT r) 
666 14hCS 44k cs a 4HFECM,4RB »FFCMA, 

“KET OLE FETT CP BRRAPT GMP Z —FRAPT NT 4 
646A {4kC 24h 20 24KKG 4 4 KG» 

669 TShDELM, SHY aCELMY 28HEDO , 4H s,£0C ’ 
67¢ 14kFCL 2 Se aEC4 a4hEDO suk ,€£02 r) 
é74 14eFC3 246 s ECR sSRE0L 44h 204 A 
672 14KEDS ,&h seh 24hKT10,44 2KT19 4 

<> A: SnD © ol 2a "7 Ka lal 10 XD A 
674 {UkFFAN, SHB aFFANB a4HKGF jk »GFa 
ATG LShFFCL, &He sFFCLA a SHFFAZ,&HB »FFAZAs 
+76 {&hEFCA, She aFFCNB a4KEF AM, 4S aFFAMR, 

677 LORGAML, SHB aGAYLB , 4K PHA, gy »PHFAV, 
678 14hGC 44k 2GC p SHEFF AX, GMB »PFFAXB, 

6990 RCT FTA FI RIC TREOT SIROL EOC 
a0 Lar {OLM, & 21CuM r) 

681 LOM TFLP, &M8 sIFuFS a SHNULL 4K aNULL ’ 
68? {ok ROL, bE a TRALL a 4KKT20, 4 2*T20 r) 
683 LORTEKR, GR aTSKR 2&SS hk S88 

684 14er7T sk alt a4 BSN, ah »FBGN, 

ar 1. \- SN ©. Lo © OY Lo Ee ©, SE Ja] 2-1) 
ERG L4&eTYZ 24K alyz a4HR2 4h aR2 r) 
687 Takke 4 bt aks atHPCa ,ah »PCA, 
6BR L4eKE 9 be 2KB asHRVBI,4HAS ,RVBIAS, 
6&9 takKC 4 & aC pBHTHTB, OHL »THPAL ‘ 
690 TaeKGL 24 oKGL 2SHhFFAY, GHB aFFAYR, 

691. yh 10h Gt) T lone eS Ul Renae Be 
692 {a&kKRGLs 4H aKRGL a4KRAF yk aAPy 
683 14eKS 74H asks ver 4 ah ak™ a 
696 (akL AMBy oh] aLarBt a bK MAX, we » JMAX ’ 
68 Lahr AaSS, a aMass s&KCO yak CG) 
6$6 LaRARLNG, 6H aKRUN r) 

et ky TA 
698 L&RhPH IM, SHAX »PHIMAX »&KSB yb 88 ’ 
699 LeMPRINZOHTM = ZPRINTM pp bHUMAX OH a JMAX F) 
700 L4RRAPTZGHM2 ,RAPYTM2 sSHRAPT,ahM{ = ZRAPTMY 
7C1 LeeRCET, OH aROeT yeHXDTA y aK OTA 4 
762 L&RRFLES4HCT REFLECT 2 &KPIT ub oP, 
ti it PF RE SET PST 
704 L4KRLAMZ GRY = ARLAMY =p HHRPST OH »RPS] ’ 
708 TaRRNGLZOHIN QRAGLIN sOMVRAT, CHE aVRATE, 
7064 L&eRTM TZ GHA aRTMIN aeHKM 44h aKM ’ 
707 14kS7 ah = 87 p4HS6 44K = 86 , 
7cR {akSio 2k 2S10 24HS9 yuh 189 

“IOS ee ¢ tosh te 
710 14kS54 24H Sh 24KS3 4k 283 , 
711 44eS2 7 4H 282 s4hSt 44h St r) 
F12 14S a 4k aS a &KDELM, &Hx a DELMY ‘ 
713 TokeFo 74h s8FO aeHSFY 2 aH 2 SF4 r) 
714 L4hsFa ,4H aSFo e4HSF3 ,&k a SF3 r) 

SPE ess Se tp te OF 7 Sa eS PR 78FS r- 
714 L&akEF6 24H eSF6é 24HSFI sah aSF7 3 
747 14RSFR 74H aSFa peHSFe sah sSF9 , 
79 14kSF1Cs 4 aSF4i9 ;uKSFA 1) 4X aSFi4 ’ 
714 Parker ies wh aSF42 yeHOF 4 9, 6H sSFi2 ’ 
72° L4RSF14, 4K 2Sk44 24HSFi 5,4 »SFi8, 

PR te iP Hr SEO OEP —7 OMSL SP re Het — rb OP rs — a 
Jo? 14hTCi 74k aTC4 2&kTO hh 279 ’ 
723 14k7039 2 4H sT¢3 rbHTOP sah sT02 ‘ 
TA4 14hT08 74H 1708 a4kT0% 44h » TOs ’ 
7% LahkTO7 aah ac? s4HT06 14K 21706 ’ 
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726 14kT2 94H v2? e&hTy yp hk att j 
J27 {4RYB 24k 78 aShRSPT ghk ,SET 7 
728 Lak TReL ys &HC aThAL Ds 
JOG ERT AG TRO TREC OF UHKD FH 1XCa 
730 LURTKET,SRAT ZTRETAT 9 4hT RAP, UF »{PLe ’ 
734 L&R TRALZ SHO sTRKALC ’ 
732 L4eTIC 24h atte ahh T TOT, yh »TIC!, 
733 L&KTIME, SH3 »TIPE3 pSRTIYE, GND »TIMED ; 
738 TSR TIME, SHY aTIMeEy ehHT IME GHG pTIMEn F 
ws “YURTIFIT aM — TYP BROT FG Pipi ’ 
736 LakYME Bs 4KV aYHFAY s4HKS yk “5, 
737 {4k 7MINg ok aZMIN a SET IME ZU KY eTIVEy ’ 
738 {ohwhCB, 4H aWNCS abkIPh TN, Gh IMIS 
739 GATE (001) «SET 
749 166% CONTINUE 
7. °°. RINT S00C7 a a a eee 
7a PRYIAT 9O0OCOs 4p 4HPRAUAUNELC TL ,emLEY pbk 
ya {SrrTIée, 6A 2TIMEe aSKRSA yuh rRSA - 
Jaa L&ERKCEL Vs 4HP sDELVP y&ky 24h aU , 
7388 Loey 78H av a8tw yg ¥k Ww ; 
766 LaHTKTAs 4H aTeTA pbhPHR yuh »PHO ’ 
~E TCE LZ CEL ZF aevevasarcc = .TeTacc 
7a$ 14kCZ 74H 202 aSHDY yah 20¥ ’ 
780 LaBCPRIs aM sOPKY a SHOTHT, BHA 2OTHTA ’ 
784 {4eCX 94h aOX a &HOPST, &H sOPS) , 
782 {44OR 7 &K 20R 24KNQ 4k »00 ’ 
733 {&kCP 44H a0P s4HDw 74h Ow 3 
sr — ROI enya SOV , 
785 {&RVRW 94h sVRW 2 SKMACH, Uk MACH F 
vA-T.) 1GMCAP 25 GaP gSKEST 444 2?St ’ 
787 LakpP 4H aP a &HO rx Yo 2G ’ 
7358 14KR yaw aR a BHDELV,&KY AYELVY ’ 
760 L4HAZE 24H aAZB 2 SHNELY, ARV »CELXv , 
TELL PV FOET VP RRCEL ZI OHV SDELTV OG 
7&2 LoHx rx de ax a4ky 24h rY r) 
763 Lee7Z a a2 a SHAME Gh 2 AMB ’ 
Iba 146*xT aah axt eskKvVT 4 yh »T ry 
16 LSROTRT SHA sOTRTA a 
766 14RCPHIZ SH CPR a &HSPUy, eh sSPHK] , 
167 -—- —yeHePstyar———7ePSt— 
768 LekKCPS1s4HS aCPSIS 2&HGZB 24H »GZE ’ 
Pi) 16kGYB yak scyve peHOXB 2ah 2Qxe 
774 PRINT 9OOOOs Se 4HAUTSSGHPILG, BHT! 2» ek , 
972° YSHCCPHseHIO ZCOPHTO » 
773 L&eCELXs 4HS s0ELXS 2SHPEG 24h »PEG , 
UMTS —sERTXED GE HTT KET 
77% L4ROEL Zs 4HS sCELZS adhOheG, aba sOMEGA ’ 
776 LEHOYERs 4 sOYEF a SHOPEP, ah ,OPEF F 
7997 {4MOTHTs4HAS sCTHTAS 4&HRTY 44H RT , 
7748 YseRT 4 oH KT a SHPEFL GH »PEFL, 
778 14¥NULL» 4 aNULL 2 KHOELP 4k »DELR ’ 
Sy rePe ZT OM EZ FHP SPE TSH TPSRG™ 5” 
7B {eRPEO 4h oPEN aSHPEF , ah a PEF r) 
782 {ORPITEsSHRO JPLTER® ys, SHPRIG, Ss puta, 
783 {4ePSIS, 4H sPSIS , 
784 LORPXECS OH aPXED abHT HAS, 4H a THAS ’ 
785 14HPSAS) 4H aPSB8S s ARDELL» aH ,0ELt , 
Y—peHRtamyele — FREAME — 5 
787 LahTKT A, SHS sTHYAS 2 4HTHQOB,&HS »THRAS r 
788 LeRYER yah aver sSHPEF aH a PEF a 
739 La4RYEC 24H vYED a4HPED 24H »PED ’ 
780 {SRYEF 7aH rYEr 9 4YB9G, 4H »YBRG ’ 
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79% {aMVEG s 4H sYEG s&hOELY,4HS 2CELYS ’ 
792 LUKVAWEsSHRR ZYALERR 2 GRVALF RRA {VAST IA, 
7993 L&hL AMY, &KR aLAMYR 2 SPLAMP BR »LAMER , 
0 IOS TO FCS ORC AP STEN p TAPS ; 
798 14koPS},4HS aDPSIS aSKTACC, GY »tacr ’ 
7964 {4RPSRE,4SHS sPSRAS phHRES yuh aes 
797 PRINT 9OCCOs2.SHLAGIZ4HC? 
758 TaMGATEs 4¥ 1,GATE (001), 9HGATE, Ob PrGATE (CAP), 
799 QUKGATEs 4H 9,GATE (003), 4HGATE, Oh ws GATFI COS), 
0s GR TES 8 STGETE (OOS TF SRGATES BH RVGATEIONA De 
801 JORKGATEs AH 7sGAYE (007) 
&02 PRINT 900005 6s SKAERM; GHOYNA, GHMICS, 4h} ; 
403 14eCLC 24H sCLO asHaLa yok 24L8 ‘ 
Oa TaRCNR 98h aCKR 2&MCPKS 4uH CMG ‘; 
acs {akCY 2 4H acy a4HCAZ yeh ,CAl , 
ae 1+] ee © 1.490 i lay 3 Me LAS SES 2 ND ' a 
807 14™CYCGs 4H 2CyYca a &kKCMCG, 4 »CKCG . 
ece LS" ANB 9 4h a ARE a&HCLA 44H CL$ ’ 
808 LakCMA 2 Sh 2CMB ebHCN® yah CNB ’ 
is L&RTHAS, SHC aTHwaset sBHOTHA,BaHSO ,OTHAGN 
ae {4hPS1S,4HC aPSTSO a4HOPsy,aksD = ,CPSISC , 
BO CRC TRE TAT ON — OT BET I 
Bil PRINT 9O0OOs 1s 4HRAPI, 
e12 tseerTt sah aSsTt auhCY? ,a* 4ETY ‘ 
813 {smSPT 24H aSPT ssHCPrT sak CPT ‘ 
1s Ta Th a4 aTkK a SHXLTA, 4H oXULTa 
ais PRINT 30000, 32 4HKCEBU,&KG PR, OHINTI, 
, 6X HOTEL TF EMDELT FEN —— FOEL VST : =? eae 
ie LORCELZs HE sCELZe a SHOEL Xs GHS »DELXS, 
a18 LSECEL Ys SHS aCELYS aBRDELZs&KS sOEL7S, 
819 LakKUTTs SHA aKUTTA r) 
#20 TEMPTTESSHRR ZPITERR ,SHVYAWE, BMRA ,VANFRA, 
R24 LHKPITESSHRO ,PITERS seh Ane, UWRF ,YANERO, 
3 SORT HEF ORE RF ERE SFO GF ca aa 
823 BahCRPES, oH] aORPS] aSHORTH,aHTA «ZORTHTA 2 
824 QRRCREM, HIG sORPHIG SHRP T, BHG eRPHTG ’ 
828 L&HDELVs SHR sCELVR pSHOPK I, wHC 2OPHT9 2 
226 1&8kG aah a aSHVSSO, aH eV$N9 ’ 
&27 14H ISKR, as atSka ebHT ACT 4h stacy ’ 
S92. {Sc aa a FOCI CET RPT ERE 
8293 L&RKAGEs 4 eK AGE 2 4HNAVY, OH sNAVY ’ 
330 Beker, sat aFt DOHORLA,SHWR ZORLAMP os 
a34 ,SRNUM 2 OH aNUPF P4HTPRY,BWNT ,IPRINT 2 
242 TEKNPPS, OH aNPPS aSHNOT yah sNOT ’ 
s 


P38 14KRHB 24H | FREE ’ 
836 tekge seh = 582 sOHMELR eHAL DELL 6 
a37 T4KREC 24% = PRED saHREY ,4K = RET , 
838 LahREG yaH = REG pehRPSt yah = RPST 
16 LSKRTHTS4HA = GRTHTA > 
86 rE eT TIMES T, 
Bat 14RNX 44H aX 


843 LaePCAT, &H aPCAaT a 4HOCAX, &H »PCAX ’ 
aay LeePCRYZ¢H = PCAY «=p AHPCAZ,GN = PCAD 
£48 14hPCA 28H =a PCA 
£8 PRET rt ERROR 
847 sO CONTINUE 


Rafe Patan FND- BUN 


Cc 
&49 Cc NISPLACEMENT ERRARS FROM AI POINT 
850 ¢ 


033 LekhOTA, a aNDTA PYRNULSZHHKR — pNULSKA 
OT 02 2 Os as Lik RE Maddie 1 da ad a res 
pistes NY 
' 161 


#84 c CISPLACEMENY ERRARS FROM SPST 


asz ~ CEL XExTex 
B83 CELYaYTeY 
nnn BELLE I IO i > 
855 IF (TIMECLT.STIMERIGE TA 54 
aS6 c 
857 TF (ABS(DELY ) ¢GTeCELMYIOELY eSTGNITELMY, °F. 4) 
ass TF CABS (ORL VP) eGTeCELMXIDFLVPASIGNISFL YX, SFLVO) 
aso TF (ABS(DEL3 )cGTeDELMYIDELS gSIGNI(DFLMY,%FL2) 
FBO BST ODE VET 9 GT a VRATETNOELVP UST GNI VRATI YS ONEL VE) 
861 IF ({ABS(ODELL )eGTeVRATEIODELS OSIGNIVRATE,OPELG ) 
862 TF (ABS(ODELS )eGTeVRATEIDDELZ aSIGS (VRAYS, “NEL ) 
864 IF (LACT«GV¥0O)GE TS $1 
aba « CELL « YEG*REG 
863 CELVP @ PEG 
s6o7 DECS W-SVEQSREG = 
867 IF CLACTeEC CQ )OEL1 OREGe YFG 
366 IF (TACT cEGe2 DEL 3 aREGSYFG 
869 Sq CONTINUE 
876 RETURN 
art c 
2 ER Ry NY Se ae 
8793 c 
S74 c 
ays IF (TACT EG e1)G8 Te 40 
474 XT &© XTOOTRKSVXT 
897 YT 8 YTSOTRKeVYT 
TRGB COI IN ee RE ES 
879 V¥geLeVeVeVewon 
880 VF eSGRT{vMa} 
Bal TOTACCe (SGRT (AYRGAYBSAZB@AZES )/MASS 
R32 CewaueTRAVECTORY TERMINATION 
883 IPF (TIME SGT eRe eANCe2eGTeZMINIGA TH 48 
e e Ps 
8388 #8 COATINUE 
886 DELXT we XT#x 
887 CELYT 8 YYeY 
BBS ELZT wv ZT#Z 
gas CELXTH9EBY1 ODELXTOERI DODELYT+EBI 2eDEL ZY 
<DEL YTB VE BZTODEEXTSESSOHOELYT SEBS TUDECZT = 
agi CELZTGeEBI1 ODELXT+EAS2SDELYTSEB3A°DEL ZT 
Pty fst 18S 38 £C8 
833 VERLAMSATANQ( @DELZsSGRT (DEL X#OELX*DELY@DFLY)) 
89s -  WORLAMUATAN@(DELY, CELX) 
895 Ca® TATAL MISSILE N&NeFIELD ACCELFRATIAN 
S960 oo BO ee ee a 
897 GAMPaeATAN2 (We) 
ag98 RTUWSSSERT (UeUewsw) 
as$9 GArYeATAN2(VsRTUNS) 
$00 Cee RCS Te VCS TRANSFERMATIGON 
904 CALL TRSFRV 
02 ERB ER FIDE TV eR ODELZ VI CZ YT > me 
sos GS Ts 73 
908 157 CONTINUE 
$08 Cosws RANGE TARGET FROM MISSILE aRYM IN FEET, 
908 RIMASGRT ((XToX)eese(VTwY)} eere(2TaZ) #2) 
6c? Coees. POINT OF CLASEST APPRAACH CAMPUTATIGNEPCA TP FEFTe 
: etvOhrPCKIGl 18-58 eS oe 
9098 PCATSENGLITIFE) SPEAK MXSPCAYSY yPCAZaZsPCAanTY 
e10 °° 85 CONTIAVE 
Sig Ge 76 9 
912 73 IMPACToc TRUE. 
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a ee aN 
' - 
{ rf 
i 


9998 


x <x «KM K 


IFRINTHC 
PRINT SOCCO,2s4KIMPA,UKCT] ,ARTI ME, ab 1TYMr 
G8 Te 9 


a 
ERROR ee TRUE, 
G6 Ta 70 
PRIAT SO00COs Ss UKEND ws BHAF ery uWILE 2 4HON LW, aeNIT ID 


YAMLON Te OhT sLUATT 


C8 3.c1 194,46 


C8 3122 101,3500 

CALL WOACS(0s,16,™0DAC) 

CSATINUE 

CALL MERF (IE) 

CALL WEAF SBA 
CRE ON ee 
CALL MODE('R!) 

CALL MODE(tPr) 

CALL WEOF 

CAL! PLOT(2,* YIME',2,' TTXED 1) 
CALL SGBRLS(tAV ') 
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4 


el nea ala ae 


27 


SLBRALTINE SEEKER (SPAGE REFLEC, ERR SF R49) 
CIMEASTON TRAGE (ARS TOFLEC(A THUG RA) 2h BO LECN TEAM Eb AGG? 
CIVENSION TRaCigy 

“TP RYK TRUCE ZT © BNO pBOCE BT Rl ed R Te Bd Me POO 8 Be 
LUCOO es SCO BNCC ARID es LOOCO er LPONO ALES Met OM OS 
CATA TRELEC /1e25,5e/ 
CATA TLOS Sup eSpofeWrapelLosATsabeseeRUrreebh Tetons e ede oe 
£63675 03332685 667s sB3Be Lee lelOFstoBdUieSys 
CATA TRAT ASSIS ERTS REEL eee ce ee ec re. ov) 


r=. Cre THS7IVZE “TY PCeGF OLE Tear wl OTe BF al He Webb el ay CeME Loa eel ws %y 


AD -QE LI Sebel ssGe BE opm sSe OF wt as CEL AePK ape, owl oses Terr atey 
O25 6OFolSs3ebEo lS, 2e6F 01S, 
S2e7FE CTI eCEasCeBe TEL eSopEol ps LeGEws ly Ge wp aes ata laeTeqeri rs 
BR ObEoLIs SePEel Is PeOE et IsleSPe ps Re Goths we hCoL Hs RoChriss seks 4 
SieREola,LeOSEolay 

~ CRYR OTERO TWOG FBZ 0p Ye TSs YL OBE OL Bs TVET 2s 0h Soe PGIMHOSFT AT ISh 
Le7SslLeOSshetebegsto®eteSat oMsiebs 
Feh yp eh HBEGS pe IRS yp eFehswTeIspOPeBpe lore Bist hs 2epSsredy sees 
3307230782329, B09 shear beos 
BMT CMe PCH BS yg eho Ob eds Bors ODeDpeFebpod ef Sa epee selsaeSr aes 
$3078 5390875095309, 3 09, 


GWT ST WS Vee S TOS y Sty WEEIF VAT B UTES Bhs ap etS SuvtwIrtorsr Sy 


FAL a2eee2eSr2ebs2ebslebs 

8699555630557 0308 5930p 0F02 90350708 o SS sor 04 Bre eIpeehs 05s 25s 
DeBsoFaeIs Losi oCBsielts 

Nh oy V2 Vs Oo 355 me PoDpePere Pose eBSrotoretet,oe98s,908see5,0995p 
Beepsaets 008s 0025s 005s 005/ 


28 OT ta CTT REND CT 


OATA [SaIRs JHs300/ 

T «IS 

CALL FINO( I, 7RAGEs 18, SRNGE) 
TFcetelQetS) 48 TA 10 

{Ss} 


IRE ON ERP RST THOTT STREET IBS TI TRPLECT 


383 


1Q WBeFLACTION( AMS, SRAGE, REFLEC) 
RAR GERROGI 296 
TerS))  Jeuk 
CALL FINOCE, TLOSs19, RRR) 
CALL FINO (Us TRAC S604S) 


SS re ee ee eee, : = 


ai 
82 
43 
&s 
a5 


TF(JeEQeyhw) GA T% 30 
20 [Sel yeu 

CALL NTERP (AENDs TERGs Le TLASs19sUs TRAD) 
30 @NDeFUNCTION( AEKOs RRA HS) 

ERA 6 END/9./570296 


Ee eS ee - 
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{ SUBRALTINE AFRO CTL, TOPEMACH AL PuA, BE TA,TO CVs Tl! Vaayotan, 

2 bf CRACHCGACYsCLACEs Cas Ch Oe LOs CMs, Chal Ai any mL am) 

2 i Ag 

—~o oe > apeeiceinheem pera ven ee 2 

« c IAPLYS 

é c v3 © TIME © SECe 

? a vz © TIME Ta START CANTSAL pMASE © Cre, 

8 c FRAC ® FREE STQEAr MACH AUMBER 

$ c ALPhA © ANGLE AF ATYACK (OTYCH OLALE) 6 M4, 
SLO RETO TWO AROLE WE ATTAROOS CVAW PLANET 4 °°", 

44 ¢ CELPIT © CANTRAL CEFLECTION ANGLE (PITCH PLar€) © CEG 
42 ¢ CELYaw © COATROL CEFLECTISBS ANGLE (yaw D1 adr) © TEs 
13 c CELRAL @ CANTROL CEFLECTI49% (RALLY © 0E%) 

4a c 

4s ¢ SUYPLT 
STEINER FE RACE CORFE 

4? € creG © PITCRKING MOMEAT C&EFFS 

4h c cY ® Yan FAQCE CAEFF, 

4¢ Cc CLACG © YAR MOMENT COFFE, 

a5 c CA © AXTAL FARCE CREFF, 

ai c CUP © RALL CAMPING COEFF, © (2/RAD) 
=< vr RENT CHEF ESO TTIOEGT 

ay ¢ CcKG a PITCh CAPPING COEFFe CLE TS TxFYA TAT 

qa c cra0 © PITCH CAMPING CAEFE, SLE 78 ALPua 87 

28 ¢ CLAR ¢ YAW DAMPING CAEFF, QUE TO PST SAT 

26 c CLNAD YAR OAPPING CREFF, GUE TA ALPMA C8Y 

27 c 


Se ee ee 


29 € TCat © TABLE @F CN FAR CANTRSL PHASE 
30 c TC¥CG1 «© TABLE OF CYCG FSR CENTRAL PoASE 
31 ¢ ral © TABLE 8F CA FAR CONTROL PmASE 
2 c TCnz © TABLE BF CN FOR BALLISTIC Pace 
c TC»cG2 © TAPLE AF CrCG Fem BALLISTIC Pwace 
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23 CPs (ALB*CL8)s 1x 
ra OGeCAMBOCME ) styzePeRextatra 
a8 ORal ANBSCAB)/TYZePeGeXINTTA 
26 CTHTAB(QPCPNT eReSPHT) /CRS} 
a9 CPhI aPeDTHTAeSpey 
~ae- Ff 
29 IF (IROLLehESCICP 2, 
30 TF CITROLL ONES C PQ, 
31 Cue MISSILE VEL8CITY IA ecs 
32 CXwES2 1 USE 824 over A394 oW- 
33 CYsEBL2*UCEB22eVer R32 
35 RETURA 
36 ENC 
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SUBPALTINE METC 


Ca*® SUBROUTINE METO CALCULATES THE VELACYTyY GF cRkuNS 


eo ORGELE PRECISION TIMESTICES~—OOO 


CIMEAKSTIO@N DUM (22), CUrV(6) 

REAL MACK 
CEMPAN/SMO/SGEBALT, 782 TGRAD,RNASL pARGLp ATYOL sRSTAR, 
TRHGB,ARGZ, GA; TMEL 

COMMAK/S JUNK/TIME, TIME, RHA, SUM 


3 é 
IF (GEGALT eG7e 3608902389) GA TA ia 
TMBL STOSTGRAD@SERALT 
Re@RRHOSL#(TO/TMAL ) OHARG 
RNGBaRHA 
VSKOSSGRT (1 eH ORSTARSIMOL/WTYAL) 


{2 C8ATYNUE 


ARG2 a «GOW TMBL # (GEBALT #36089. 2389 j/ (RSTARwTMAL } 
RROeRKGROEXP( ARGO) 


23 RETURN 


END 


Fe a Tt th einen ee 
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1 SUBRAUTINE SEEK 
2 Ces YkYS SUBRIUTYINE BETECTS TARGET WITHIN THE RereCTrAK RANGE AF SFEKER, 
3 ¢ TARGET WITHIN THE FIELD OF VIFWsSeAeksSEEKFQ wiTWIX LINEAR MANGE 
TR twee OMG A ne og Te pe PL eo PP EL Aen a om 


8 COUBLE PRECISION TIME,FSTSAM,TIMFA,OTsDTA, TST, THE ZSPER 
6 CIPENSION CAT(18),RAT(49) 
7 COPMOA/STUFF /CELXS,DFELYSsCELZS 
g COPPAN/ JUNK2/SRNGE, IFUFRs TACC,ROFT, YAWERA, PITERY, PHF OV, BAZRNGLIN, 
8 LPI T¥ 44 5GeR20. NULEKR,» BAS REFLECT sNLLL s KAGE 
CO LEE TIPE SP TT ERR TY RE RR 
ai COMMONS JUNK /T IME 
12 COMPARSINTEGs I sp Us DPRK SCAT, THTASS THAST PSIS, RAT 
43 COMMANSTT/FSTSAM, TIMERS OTZOVAsTST se TME SS: Fs TSAMN,O0s UMAKs LORIAT LTO 
a SRAGE OSGRT (DEL XS SDELXSODELYSSDELYSOOFLZSeCFL 7S) 
ie CAyA fACQ1/0/ 
YS = ATIF CPCTECsC TUG 10 560 
ie IF (CTIMEsLTetT2)GH 74 108 
2a mos Yoo “IF (TACSL ONE OIG Te if 
Qe IF (TACQONE*{)GB V6 10 
ae FOYSAMETIVE 
5e 10 IFCTACCeECoR) LACCi sl 
OTT CERT INE SS 
16 GO 76(5650107)2 acc 
pS $60 COXTINUE 
20 IF (ACGeEQe2)GA Te 107 
a PETSAMETIVE 
2a IF(TIMESGECTIMES)GG TE 565 
wr _ Prin Saal tae a eee 
2e Coeee ACCLISTION( L¢CGeg) WHEN TARGEY Is WITHIN CHeAY AND ROET 
2 -s Z 865 CONTINUE 
a6 
27 - Cee LINEA SEEKER NO OUTPUT WHEN CLIT AF FOV 
a8 TF (SQNGE eGTROETIGO TO 101 
; ee 
30 LF (GCRT (PI TERR|@2eVAWERRO02) oGT000872666)G8 79 101 
3t ~~~ = HISORT (PSE SePSiSeoTHTASOTHTAS) oLTsBAI68 TH 10% 
32 $67 COATIAUE 
33° —- Cweee-PRINT-EVERY JHA INTERVALS 
3a UPaxeledCsSTAesCoo00! 
SSS 0 eee SS 
36 CTRKSSNGL (OT) 
37 a P: tacGet 
38 IPRIATo? 
33 PRINT SO0OS 
40 S0COS FURPAY( 722%, 1ACQUISYION') 
* a ay Tee ee 
4&2? 109 COATIAUE 
a2 Ceves KELL SEEKER 
as PIVTERRATAN2( @CELZS,0ELXS} 
as VAWERROATAND (DEL YS) SCR (DEL XB ODE XS*OEL ZS eset 25)) 
a6 Cc 
IOS PI ne 
a8 c 
ag TE CSGRI (PLT ERROPTTEORSVAHERRCYAWERR) OT ePuMAVIGA TA L101 
80 PLVYAWGCSSCRT (PI TERA OPI VERO SYAWERTOVANERS 
$1 TE CPLYYAWSCeL 2 0008 /P BD NUL SKA ee 
82 103 COATIAUE 
RE Cr SA PL BRAND HOLD LE FES AME IME-TQ ENCED EAP TER-ST ATEMENT 3 (HO ——— 
LT) TSYeTIMEeFSTSAM 
88 TSAPGCTSTOTME 
ie If ( TSAMOGPER)108,1082108 
87 108 TREVTMESEPER 
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5a TF (SRAGEsLT»RRS)GA TE 108 

3g IF USGRT (YAWERRAYAVERRSPI TERR EPTIERIR) .GTePHESVIGST TA 108 
60 IF (SGRT(PSIS&PSISSTHTASHTHTAS ) eh TeBAIGI TA OR 

Gic- . a sea KERTSREGESRFLECTIPIT ? 

62 CALL SEEKER (SRNGE,RFLECTs VAWERRs YAWER A) 

43 PITEROSPITERR ; 

64 YAWERBeYAWERR 

63 GS Te 109 

66 104 YACCaNULL SKAGE®4 

BI oO VR RER OWE : a = 
68 PITERG a0. 

63 109 C8ATINUE 

70 c 

val Ces SEEKER WITK LINEAR RANGE 

72 TP CARS (YAWERD) oGEeRNGLIN) VAVERBASIGN(ANG! IN, VAWERD) 

cy & oe R 7GE. STNIPTTEROSSIGNTRNSC TING 

vu 408 RETURA 

75 EXO = 7 


179 


{ SUBRAUTINE EDSKRGYRE 
| cn ct THIS” SUBROUTINE CONSTRUCTS THE SFEKER GYR" vareL FOR £0 
3 c 
— 
5 REAL KToKT10,KT20s LAMPRsLAMYR 
1s REaL *G,KT30 
6 LOGICAL FLGaseTRLE os 
9 COMMANSINTEG/KUTTA NX DIRK DUS Va Xe BAC RePUT, THYA EST a Xs YoZsRThT As 
a LRPSTa THTAS se TKASNSPSISsPSISD, OMEGAs TXFCsPYED,OFF, VEF sDEL Le CELVE, 
3 RED ODER VPS COEL IT RELAMYSREAMPTRPNTGTNPHTOsbU2 DV bwstPr bso Ra 
10 3CPwy ,CTHIAOPSI sCX,0Y,0Z2.NRTHTA,ORPS] ,OTYTAS, OTWASDs0PSIS,0PSISO, 
44 &COMEGACTXED, OPXED,OPEF ,DVEF, DDELP4200EL OS, NFLPA, CLDELY sCDUELP> 
12 SOCDEL3s2ORLAMY,DRLAMP,ORPHIG,COPHIO 
43 COPraAN7 JUNK STINE 
446 See ee OTA STS Ta TMF ZSPER, TSAMs COs JMAX, IFRINT, T2 
COMPAR PERV. 20 “tke” SS he A ae ee ee ee 
16 COMMAA/BOR/RSLK “)K71 Os KT20s LAMPR, LAPVR RTF ATKIN REGEDEDY PLGA, 
47 LRSAVECS,CSA 
18 CO8mPOK/B7S/8S1135881258S13, 8821, 852228823, 2631 08839228533 
48 COMPEN/ JUNKO/SRAGE, IFUFR 2 TACO ,ROET, YAWERS PI YERS, PHPOVs BA, RYGLIN, 
20 LPITYAWSGs 220, NULSKRs ERS» RELECTs NULL» KAGE 
IE INT ? TATED 
21 CPmsOeDPHI 
220° RSLUY 250 /R2D5 IF CARS (CPHIO) GT eRSLIDPRIOSSTGNC RSL, CPMIO) 
23 TFCTIMEsLTeT2)68 18 5008 
is =F SG: 
ae CaseeeChECk FeR NULL SFEKER 


ka A Ra 0001 
ae TF(KULL+EGe2)08 18 5000 


1. NULUEL 
68 RSGE sSQRT ( THEASOTHTAS OPS IS eNSIS) ITF IRSGE OLE eOe3/R2D SAND e LACQeEG 2) 
ye ~- {RULL 2? 
ge CaeeoesF (SCRT(PITERR|SDeVAWERR@ OS) o OTe PHFOV) LAC TANULL AL 
. iii ah rl a 
10% c 
TLE es TPIRULL ECOL ILAMPROLAMYR OQ, 
12¢ c 
an IF (NULL eo EG et KT eKT20 
as TF (NULL EG o2)KTeKT1O 
SO PRES REAM TOTS S BPO ES TIREKMVUSTON SSI OBRSETRE BEY 
a7 OPEGVSKT OPI TERG 
a8 . BPECTUKTCYANERG 
r+) TF (APS COMEGY) oGT 001745329) OMEGY OSIGN( 61745329, 9"EGY) 
3c ra a TPC ABS (OPEGZ 3 eG Teel 748329) OMEQZ eSIGN( 9£788329,0"E02) 
31 LAMPReGMEGY 
ze O S — al 
45 ¢ SEEKER GYRO FAR FD 
46 c 
a? 5008 CONTINUE 
&R IFC YIMESLVePO1)GA TO 6670 
a9 IF (eKATOFLGS)GO TH 6670 
SO RAE ET FE CHT NET EPL OS TPR INT-9 0005 se 
Si 900CA FORMAT(/s2X,'UNCAGE GYRA FAR RALL TA VERTICAL? 
82 6470 CORT IAUE 
53 IP (TIME cG7CEDSeANDe LAC NE ePeAND el TUFB CAF oP KAGE OL 
Sq TF (CLTACCeECe?2 KAGE SO 
ge GCSas@S2i eFensezensgso3eR 
“SO RRS TOPO BB IB LOB SES ER — mo 
8? GO T0(5200,5201), KAGE 
88 ¢ 
88 Cc CAGE 
60 Cc 
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Ad S20 MTBTASSe1CesTHTASJCPSISe=10,4PSIs | 

4? “-GS8S TA 5202 

62 BPS. GI T8(520205204),1ACG 
a 

65 C LNCAGE 

64 c 

67 C FREE GYRA 

AR C 

x) 5262 CTKTASseQSA/CAS(PSIS) 
SK ——— ee Seence CD 

74 68 TP 5203 

79 Cc 

73 C TRACK 

74 C 

7° 5204 CTmTASS(BMEGYeQSA)/CBS(PSIS) 
+ . oa 

72 R2Cq RETURN 

7R ENC 
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t SUPRALTINE EDAP 
3 “CBS THIS SUBROUTINE CANSTRUCTS THE ALTAPILAT YATEL FAR ED VERSTAN 
3 OSUBLE PRECISION TIME 
Se ee OGL EA 77 ? 7 CTCRCESS cS 
8 COMPON/ JUAK/T IME 
& COMPON/S8/8 3 5S27S3,58.S58986 
9 REAL POLES(01)70200/ 
s REAL KPOsKO, KML AMT sLAMPQ,| AMYR,KG 
9 COPPAN/SUTAPS YEG, REG, PEG 
OF TT an COM ENT BONS ISCFKTVIKT LOD KT OO LAMPS LAP YRENT IS RIMING RSCEFEDLS PEC 
41 {RSAs2E04s2 OSA 
42 COMMONS JUNKQ/SRNGE s TFUFA 2 TACQAROE Ts YAWERS, PI TERS, PHF OVE BAPRNGLI'> 
13 TPIT VAWSG2R20, NULEKR»s BRS sRELECT NULL 2 KAGE 
[4 COMPON/ARROA/PHIGSFLGS oFLG2eFLGS,REF REL, VF Os.FEDs PHRASS PSABS, 
15 LTKBS»PSES,GBLY2PEFL ea KPDsKGeKMsKG,LAMBIs PALES 
KENXTOTRE GUT VG Wa PT CENT PRT THIRG PST TRI VILE INT A 
19 ALRPST,THTASs THAEDs PSIS,PSISDs OMEGAs TXF Os PXFOSREF » YER DEL a CELVP, 
ig 2OEL3sCOELS sODEL VP» CDEL Za RLA“Y,RLAMP »RPHIG. DANIO, SUs Ve OW OP POG ,OR, 
19 JOPHT »OYHTAsOPSI sOX,0V,0Z20RPHTAsORPSI sOTHTASs CT HASO,0PSIS,D0PSISO, 
20 = &COMEGAs OTXED, OPXEN, OPEF sOVEF s ODELP 3 » OOELPP, ODELP3, ODDEL1 » COVELPs 
at SOCDEL 3s ORL AMY, ORLAMP» ORPHY G, OOPHI0 
ray) r) TTMEDSPERS TSK SCOT IMARE SPRINTS TO 
23 ¢ ROLL AUTOPILOT 
. . ios ye aah Soe x. 5 i 
25 IFCTIMESGECEDS)GEA TA S025 
6 ooo ETO PH IO SS 1 OTR, UPEISSSe- 
297 Ge re 5030 
oe 2, Senne. .1¢> ¢-man od 7 
ay IF(TACQeEGe2)G0 7A 5025 
36 ‘ste a ~~ PMT GeeDPKIOSS1 675, PS SeS2 
31 G6 Te 503Cc 
> — “BOS TF CeneToFL OIC TH 6667 
32 PRINT 9OOKVS ITPRINT A2IFLGLeeNSTeFLGOL 
“se ry 
38 __ $667 CONTINUE 
36 ~ DRLAPMY#10.8DPHIO 
39 PHTGeoDPHlOeSieRLAMY 683 
38 . j 
3$ Ce. LEAC LAG ROLL AUTOPILOT REG/PMIGeKPDe (Sen) /G0i2e5) 
oe |: a a. 10K |) 
“4 CALL FLIR(PHIGs,RPHIG,ORPHIG,REGs 1205 280eKPO) 
CY ie RYU TT EsREOST LF CABS (RECT ECT eRFL JREGEGSGN(REL, REQ) 
a3 € 
as - Cee Piru Yaw auTePrcer ia 
48 Ces RATE CAPFING OF GIMBAL ANGLES THRBS/THTAS aK GeS/ (200670943 } 
36 COT TARGSTPOLE S (O04 Pe KES RM, THOSE 
a? CALL EORTDAMP(PSIS,PXEDsOPXEDs PSRBSs POLES (01) 2K 2eKMsPSBS} 
a8 Cc THPUT TH -CUTDANCE FILTER OPED, YEO 
“49 $968 COATIAVE 
“80 PEDULAMPR 
81 YECeLANYR 
$2 8078 CONTIAVE 
8% CALL FYILG(PEOs FEF, OPEF 2 KG,190) 
$5 CALL FTLG(YEDs YEFsYEFs KG, 100) 
86 PEFL ePEF+ LAMB! 
$9 GBLVe8e/RED 
5 aaa ae StOnt Gat PEF y+——— 
59 IF (ABS(YEF ) oGTeGBLV) YEF eSIGN(GBL ve YEF) 
60 LF CTYIME SLY eTZsGRetaCCeECs¢ 346 TS 9309 
61 IF (eKOTCFLG2)GO0 13 A668 
62 PRINT SOOCIIIPRINT SS IFLALWeNOTeFLOS 
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63 9NU03 FIRMAT( /a2Xs LATERAL EWAGLEE j 


7. “b66R CONTINUE ~~ ae 
68 G8 78 (§080,5085),AULL 
ST BOBS PEGI PEFL TRESS HSS RC TURESUSE) OSE 
67 VEGRYEF +P§B8S+S6ePSRBSaS& 
6a G8 Te 8100 wean : 
69 S085 IF (eNGTeFLG3)GB T8 6469 
Te) PRINT SOOOSSITPRINTs2)FLG30 NBT eFLQI 
74 9CCOK FORMAT(//2X%, !GUIDAKCE ENABLET) 
73 PEGe (PEFLeTHRAS#S4 ) #S 
I% YEGeYEF aPSRSS&S4 : 
78 5100 IF (CABS( PEG) eGT 00209439968) PEGSSIGN( 6209439uRs PEG} 
76 ee TE {RES UNEGINOT ewEO4 IAB INEGEETGNI veO78395 Re VECS 
79 RETURN 


Se Ss a a a aac: | » ame aaa: 
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SUBRALTINE FLTR(XsV¥sZeA0Bs CoC) 


nn 4% «1-0 2 
Aa(C#¥42)4#D 


SS RETURNS 


Fl] a Ue 


RW Sl dU 


ENC 


— en a ree 


SUBRELTINE EDRTDAMP (Xa Vs ls As Bs Ca0ek) 


a a TERW (CHENEY 


Ase (Caxey) 


RETURN 
FAT 


SURROLTINE FILG(xe Vs 2, A08) 


ZERWT ASX OY) 
RETURN 
saa 2 
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SUBRSUTINE CONTAL 
YKYS SUBRBUTING CAKYAINS YHR CBAYRSL SYSTZé,CANkADS FOR EACH PLANE SN 
COMPAR SHAFY,SECEND SROER ACTUATSR MADEL 

COMPRAN/ JUNKO /SRAGE  TFUPP ST ACC ROE Ts VAWERS PIPERS, PHEOVSBAQRNGLING 
TPIYYAwSCs R29, \ULSKR, BRS, RELECT NULL» KAGE 

COMBA sAUTAPS/ YE G,REGs PEG 

COMPBN/INTEG/T a Ja XCT es CELL, CEL VPsCE!, 9, 00EL 1s COFLV?, ODELIsACTS, 
LOCELP Ls, O0ELPP,DDELP3,00PEL1,D0DELP,ICCEL3,aCTR 

MEST IME TI LMC 5 S507 SCOWT CAPT TNE SG RAAT VY FRAP THOT IRC TY 

LSLAPE 1, BT 4eRAPTHZ, BLOPEZPBTSOCTT,CPT, SPT sXLTALBTTs GAPSsCAPSU, 
2GAPSr", TH 

CCOCEL 8600 #(KOeeLYEGeREGENELL DCONELL) 
COCELPHSOe 8 (8008 (PEDODEL VP} @DOEL VP) 

OCCEL 38600 (4000 (oVEGeRPG2DEL3) eNDELI) 


pcr CE TOOEEET SBUS PREC VTREGH YE GEDET Test eO 


9 irr 


IF CLACT e&Ce2 )O0DFL 9060001600 0 (REGOYEGSOEL 2) &D7EL I? 
OCELPISCOELy 

OCELPPSDDEL VP 

CCELPISOCELS 

RETURA 
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ACSIGN (MISTsRIT,%6) 
a . SY? GO RGee Le 
ALAA (TEMPZECC) a (LIPsUSERs SYSTEM) 
tREAT (FILE,ETsGAsFSD)) 
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Appendix C. 


6-DOF DIGITAL MISSILE TRAJECTORY SIMULATION 
WITH DYNAMIC GYROSCOPE MODEL 
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